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Abstract of EP0671246 

The rotation point always lies at the origin of a 
base coordinate system during changes in 
orientation. The workpiece can be gripped as for 
subsequent machining and manually moved so 
that characteristic points are moved above the 
fixed workpiece, whereby the orientation is learnt. 
The programmer can specify the nature of the 
connections between points. The base 
coordinate system can be fixed within the tool. 
The position of the gripper coordinate system is 
determined in relation to the base coordinate 
system and hence to the tool. 
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With the numerically steered treatment of workpieces by one machine, z more-oh-triumphs.B. it can bring a robot crucial technological 
advantages, if in relation to the conventional treatment with that the tool is led by the robot hand across a stationary workpiece, the tool is 
stationarily attached and the workpiece by the robot hand across the stationary tool led. For the latter mode of handling by robotic control 
a so-called grip arm-referred interpolation is made, against what with the conventional guidance of the tool over a stationary workpiece 
basis-referred one interpolates. 

The grip arm-referred interpolation brings several advantages to the user, and. A. the structure more simply, one necessarily only a grip 
arm and saves the clamping device for the workpiece, a stationary tool is subject to fewer restrictions in weight and dimensions and the 
supply installations for filler rod, cooling agent become clearly simpler, since they do not have to be supplied by way of the bionic arms. 
Secondly one obtains shorter cycle times, since one brings the workpiece in a processing step without stopping and embracing, to work on 
and again remove can. 

Task of the invention is to be facilitated it with the grip arm-referred interpolation the Teachen with led workpiece. In addition a variant of 
the kartesisschen hand procedure is needed, with the translation and rotation to the stationary tool to refer. In particular the tool, which is 
selected as origin of the basis coordinate system, must be the fixed point of all turns. 

This task is solved by the characteristics of the patent claims. 

A remark example of the invention is more near described in the following on the basis the design. Show: 

FIG 1 to FIG 4 illustration of the grip arm-referred interpolation, 

FIG 5 the guidance of a tool over a stationary workpiece, attached at a robot hand, 

FIG 6 the guidance of a Werksktucks over a stationary tool, attached at a robot hand, 

FIG 7 learning the course with led tools, 

FIG 8 learning the course also firmly stretched workpiece, 

FIG 9 the cartesian hand procedure with turns around the axles of the basic system, 
FIG 10a to FIG 10c grip arm-referred hand procedure modes in the comparison. 

Before with the grip arm-referred hand procedure one deals, first the problem of the grip arm-referred interpolation is illustrated on the 
basis the figures 1 to 4. 

The question, how the robot hand must change, if one leads not the tool but the workpiece, but the same relative motion between both 
* top liked to receive extracts itself very fast to the imaginative power. By a simple two-dimensional example, as it is represented on the basis 
the figures 1 to 4, some fundamental peculiarities can be made clear well. FIG 1 shows a workpiece, whose outline is compound from 
straight pieces and circle sections. If one stretches this workpiece firmly, then the drawn outline corresponds to the course of the tool tip. If 
the tool is rotationally symmetric, the outline with a pure translation movement can be driven off. 

An arranged tool must always keep against it a certain orientation to the outline. The change of orientation is clarified on the basis FIG 2 by 
the small arrows attacking at the outline. If one determines the tool and if the workpiece moves, these two cases show very different 
effects to the movement of the robot hand. Into FIG 3 the workpiece of the robot hand in the point of reference (= grab point) is reached 
and the movement of this point is regarded, which is necessary, in order to lead the outline at the being certain workpiece along. 

With rotationally symmetric tools the orientation of the workpiece, always only the contact between outline and tool can be maintained is to 
be guaranteed. The resulting movement results then simply from reflection of the workpiece outline in the center of the connecting line 
between point of reference and tool. In this case one can be converted grip arm-referred programmed course obviously very simply. One 
must reflect only all bases of the course and can succession and length of the course segments invariably maintained. 

An arranged tool requires against it a reorientation of the workpiece during the movement, and the overlay of shift and turn produces a 
very much more complex course of the grab point, as it is represented in FIG 4. 

The course consists still of straight pieces and circle sections, their number, distribution and length however clearly changed. At all corners 
the tool a time remains to the outline long at the same point, while the workpiece swivels around this point. At point A against it the grip 
arm stands still, changes only its orientation, while the large radius of the workpiece at the tool is led along. 

From corners in the outline the same problems result, as with basis-referred interpolation with a spatially expanded tool. First of all an 
additional course segment does not have to be inserted, which serves only the reorientation of the workpiece, secondly can this 
reorientation arbitrarily fast take place. The more largely the distance between grab point and tool, the further becomes the way, which the 
grip arm has to put back. Since the path speed is limited, for this a sufficiently large time interval must be taken into account. 
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In the examples shown straight pieces are illustrated on straight pieces and Kreissegmente on Kreissegmente. This is however only 
because of strictly the orientation constantly held of the tool to the outline and cannot not be generalized. In all other respects it is to be 
noted that the speed of the grip arm on the Kreissegmenten changes by the illustration (most clearly at corners). The technologically 
important speeds can be determined now only grip arm-referred from the movement of the tool relative to the workpiece-firm coordinate 
system. 

During the approximation to the stationary tool and after end of the treatment one moves the worl<piece naturally relative to a stationary 
coordinate system. One must be able to switch therefore between both kinds of interpolation fast and as also as possible flowing with the 
help of a over sharpening set. 

On the basis the figures 5 and 6 is described in the following the substantial bases of the interpolation. FIG 5 shows the guidance of the tool 
over a stationary workpiece. The movement of the tool W over a stationarily attached workpiece S, fastened to the robot hand, represents 
the ?normal case?, which is to be recapitulated here briefly. 

For a well-known robotic control the course of the point of tool can be indicated, represented by the coordinate system CR relative to a 
freely selectable workpiece-firm basis coordinate system BA. The control counts these independently around first on absolute Cartesian 
coordinates incoming goods (inertial coordinates), then on robot foot coordinates RO, finally on the robot-internal coordinate system IRO. 
From this again the inverse transform determines the oh desired values which can be stopped. By the programmer thus the basis 
coordinate system BA becomes relative to the inertial coordinate system incoming goods as well as some excellent points of course 
(whereby one point of course is certain in each case by position and orientation Tool center POINTs thus the robot hand) relative to the 
basic system BA. The interpolation works in basis coordinates and supplements thus in real time the missing points of course. Each point of 
course must be converted to absolute Cartesian coordinates. One receives the equation which can be used in addition by pursuing the 
transformation chain (equation 1) 

TWZ< incoming goods> = TBA< incoming goods> TWZ< BA> Gl.l 

Whereby T is a transformation matrix, which describes the position and orientation. The result permits the computation of the oh desired 

values in accordance with equation to 2 

THETA = K< -X 1> (TWZ< IRO>) = K< ->< 1> ((TRO< incoming goods> TIRO< R0>)< ->< 1> TWZ< incoming goods>) G1.2 
whereby K< ->< 1> for the inverse transform stands. 

In FIG 6 the guidance of the workpiece over a stationary tool is represented. 

In this case the workpiece S is firmly connected with the robot hand and becomes over the stationary tool W, z.B. a sticking nozzle or a 
welding jig led. One would like to still describe and interpolate the course over workpiece-firm coordinate system. Since the workpiece is 
moved however now, also the reference system must along-move. 

A simple and universal solution of the problem consists of putting the basic system BA into the stationary tool W and the course as the ? 
movement? of this basic system BA relative to the grab point D.h. to define to the grip arm coordinate system on the workpiece S. The 
course of the tool W is thus described in workpiece-firm coordinates. This can be reached by an inversion of the basis-referred 
representation. In place of TWZ< BA> now TEA becomes< CR> = (TWZ< BA>)< ->< 1> uses. By pursuing the transformation chain one 
receives equation 3 

TWZ< incoming goods> TBA< CR> = TBA< incoming goods> => TWZ< incoming goods> = TBA< incoming goods)< TBA< CR>)< ->< 1> 
G1.3 

The position of the grip arm coordinate system CR represented in absolute Cartesian coordinates, TWZ< incoming goods>, is exactly the 
same processed, as with basis-referred programming. If the course is indicated in grip arm-referred coordinates, one must interpolate it 
therefore first in these coordinates, which does not differ from an interpolation in a stationary basic system. The result TBA< CR> is to be 
inverted however in each interpolation clock, still before the conversion on absolute Cartesian coordinates TWZ< incoming goods>. In all 
other respects both interpolation procedures are completely alike. 

Grip arm-referred PTP sentences should accordingly to be treated. The goal of such a sentence is present likewise as TBA< CR> , therefore 
* top fjrst is inverted, then into robot-internal cartesian coordinates transformed and finally into oh desired values. Here a small auxiliary 
expenditure only in the sentence preparation, which can remain unchanged oh-specific interpolation, develops. 

After these prefaces now in the following with the procedure according to invention one deals. 

Possibilities of programming 

Representation of the course 

In order to establish for the user as clear a conditions as possible, the programming of the course should proceed so far as possible from ? 
visible? geometry of the workpiece and run off for moved and stationary workpiece to a large extent directly. The simple two-dimensional 
example in the introduction shows that a storing of the course of the robot hand is relative to the stationary tools possible in principle (also 
it consists only of straight lines and circular arcs), but becomes very unanschaulich. Thus only the representation of the course of the tool 
remains relative to one point on the workpiece, regardless of the fact that the tool is stationary. 

Apart from the larger descriptiveness this method has the advantage that the course definition can take place not only via learning (Teach 
in) with moved workpiece, but also via learning at a firmly stretched workpiece or via assumption from CAD data, whereby the interface 
remains always alike for interpolation. 

Learn with led workpiece 

With this beginning the workpiece is moved in such a way exactly the same reached as with the later treatment and into the hand 
enterprise that characteristic points of the outline stop over the stationary tool (Fig 7) thereby must naturally also orientation are learned. 
In addition the programmer specifies, as these points are to be connected by CP or PTP sentences. The basis coordinate system should be 
put into the tool. Apart from the fact that tool and basis coordinate system exchange its roles here, it does not exist for the user a 
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At everyone of the learned points of course are well-known the control: 

Position of the tool in absolute Cartesian coordinates: TBA< INCOMING GOODS> 
Position of the grip arm (the TCP): TWZ< INCOMING GOODS> 

As is the case for basis-referred learning one computes from it the position of the grip arm coordinate system thus here regarding the basic 
system, regarding the stationary tool 

TWZ< BA> = (TBA< INCOMING GOODS>)< ->< 1> TWZ< INCOMING GOODS> 

In order to store the learned point in workpiece coordinates, this result must be only inverted 

TBA< CR> = (TWZ< BA>)< ->< 1> = (TWZ< INCOMING GOODS>)< ->< 1> TBA< INCOMING GOODS> 

The points of course produced by the interpolation are inverted a second time, so that altogether exactly the learned course results. 

The tool should be not really stationary, but z.B. by auxiliary axles to be moved, TBA incoming goods< is > to be stored likewise, in order 
to make a later interpolation possible of tool motion. 

The course could be converted also to another workpiece-firm coordinate system than that of the grip arm and stored in this format. For 
learning and the later interpolation however no advantages would bring. 

Learn with being certain workpiece (FIG 8) 

Learning with led workpiece can appear occasionally as ?unmanageable?. Normally with the cartesian hand procedure the origin of the grip 
arm coordinate system is always used as point of reference for shifts and turns, in order to be able to position the hand relative to a 
stationary workpiece easily. If this is the only intended hand procedure mode, the programmer must possibly control unusually fast relative 
motions between tool and outline on changes of the orientation of a large workpiece. In addition it knows with directed an upward, firmly 
installed tool its field of work badly to sometimes grasp, so that accurate learning becomes difficult. 

For the easement of such tasks the course can be defined also at a firmly installed sample workpiece. Finally only around it, the course in a 
well-known goes describing workpiece-firm coordinate system to possibility in the same system, which is used later than grip arm 
coordinate system. 

During the learning procedure one naturally fastens a ?pointer? to the robot hand with well-known dimensions, so that the position into this 
pointer put tool tools relative to the inertial system, TWZ< incoming goods>, at any time from the oh positions can be computed. 

Sample workpiece so stretched that the position of the basis coordinate system, in which the course is defined, regarding which absolute 
Cartesian coordinates admits is (TBA< incoming goods>). 

The points which can be learned are started with the ?pointer?; from the well-known positions of the grip arm and the workpiece in 
absolute Cartesian coordinates one computes the position of the grip arm in workpiece coordinates 
TWZ< BA> = (TBA< INCOMING GOODS>)< ->< 1> TWZ< INCOMING GOODS> 

and this stores as course base. To here the proceeding differs from each ?normal? learning procedure only by the fact that not yet the final 
tool and/or. the final grip arm is used. 

During the phase of operation in such a way learned data are only differently interpreted. In place of the ?pointer? now the workpiece is 
fastened to the hand, used as ?tool coordinate system? (grip arm coordinate system) now the reference system of the course. The changed 
situation of this coordinate system relative to the flange is to be communicated to the control. The basic system BA now into the stationary 
tool put also this change must the control be announced. 

Jk top 

The course learned relative to the basic system is now exactly the same used, as if it was defined from the beginning relative to the grip 
arm coordinate system, D.h. the points stored< as> TWZ BA are interpreted now as< TBA> CR, without changing in the numerical values 
something. 

The course definition at the firmly installed workpiece uses the robot as measuring machine. Since with this procedure during the treatment 
the hand does not drive on the same course as with programming (see. the example in the introduction), places it higher requirements 
against the absolute accuracy of the robot, the workpiece and the setting than a learning with led workpiece. In addition different 
deflections of the arm come by the different loads with programming and treatment as well as a deformation of the workpiece by the 
changed situation. 

Supplementing remarks 

Basis-referred learning (Teach in) orients itself at the following principles: 

1. The position of the grip arm coordinate system is always stored relative to the basic system DOLLAR COUSIN (TWZ< BA> = DOLLAR 
POS_ACT). 

2. In addition the up-to-date stopped basic system is consulted. The user must ensure even that during later program processing the same 
or one is adjusted defined changed basis. 

3. Actual values are cartesian indicated either oh-specifically or. The cartesian representation refers to DOLLAR COUSIN. 

4. The learned position may be assigned also to a Frame (z. B. DOLLAR COUSIN), in order to define new three-dimensional axes. 

5. It is intended, over one ?pre-setting? - mask only selected components of a position to take over. The others are not then than ? 
initialized? characterized (gaps) and must during movement planning be supplemented. 

6. By learning aggregates know (structured constant) or variables from data lists to be specified. The latters are treated like initialized 
variable, are thus write protected during program processing. 
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1. Apart from the basic system DOLLAR COUSIN must be considered now also the Pinterpolation mode? (basis-referred or grip arm- 
referred). 

2. In the grip arm-referred enterprise the position of the basic system is thus stored relative to the grip arm coordinate system, < TBA> CR. 

3. In addition the up-to-date stopped basic system and the up-to-date stopped interpolation mode are consulted. The user must ensure 
even that during later program processing the same or defined changed conditions are present. 

4. The announcement of the actual values effected either oh-specifically or cartesian, the cartesian representation shows the position of the 
basic system with grip arm-referred interpolation relative to the grip arm coordinate system, thus TBA< CR.> 

5. When filling not initialized components, which can result from the pre-setting mask, movement planning must note that the preceding 
position was possibly still basis-referred started and therefore only to grip arm-referred representation be converted must. 

In all other respects the concept for basis-referred procedure can be maintained. 

Cartesian hand procedure 

Reference systems for translation and rotation 

For the acceleration of the learning procedure (Teachen) with led workpiece at least a further variant of the cartesian hand procedure is 
needed, with the translation and rotation to the stationary tool to refer. In particular the tool, thus the origin of the basic system, must be 
the fixed point of all turns. So far in the ACR planned hand procedure modes changes of orientation permit relative to the basic system, 
record thereby however the origin of the grip arm coordinate system (operating point), D.h. for turns only the direction of the axes of 
coordinates of the basic system evaluated not however its position. FIG 9 clarifies the difference by the example of a turn around the x axis 
of the basic system. 

As one recognizes immediately, by turns around the origin of the basis coordinate system programming is very much facilitated, since 
position and orientation of the workpiece are directly at the tool from each other decoupled. 

Table 1 arranges the hand procedure modes of the ACR planned so far. Three cases are differentiated internally: 

1. Translation along the axles of a stationary coordinate system and rotation around the axles the same system, however with held 
operating point (MOV, the case described above, fig. 6 left), 

2. Translation along the axles of a stationary coordinate system, rotation around the axles of the grip arm coordinate system (TMOV), 

3. Translation and rotation along that and/or. around the axles of the grip arm coordinate system (MOV_TOOL). 

EMIll.l around the desired effect, i.e. turns around the origin of the basic system to obtain one has now two possibilities: One interpolated 
basis-referred or grip arm-referred. 

Basis- referred hand procedure 

If one is exclusively limited to basis- referred hand procedure modes, a fourth case must be introduced (in the following with BMOV 
designates): 

4. Translation along the axles a stationary of a coordinate system and rotation around the axles the same system, whereby these are to be 
interpreted as being certain axes of rotation, the direction of rotation do not thus only indicate (fig. 6 right). 

In principle the same three-dimensional axes are permissible as in the first two cases. The use of DOLLAR WORLD and DOLLAR ROBROOT 
might bring however no practical use. It is to be considered whether this mode must be limited to DOLLAR COUSIN (z. B. for safety 
reasons). Such a additional definition by cases might mean on the other hand a higher implementation expenditure, there the past, regular 

pattern was broken through. 

Regarding condition transitions, z. B. by the program mode into the command mode and back, the same strategy can be used as with the 
usual cartesian hand procedure. 

Grip arm-referred hand procedure 

?Grip arm-referred hand procedure? does not stand here for the case described above MOV_TOOL, in for translation and rotation of the grip 
arm on the basis the adjustment of the grip arm coordinate system to be computed (relative to the basis coordinate system). Rather now 
the movement of the basic system is given relative to the grip arm coordinate system over the hand procedure keys. 

By this change of the point of view one receives a new, grip arm-referred variant to each of the three already defined modes. All three fulfill 
the criterion that with changes of orientation the operating point, which is settled in the basic system now remains constant. They differ in 
the choice of the reference systems for translation and rotation (FIG 10a - 10c) 

1. Translation (the basis coordinate system) along the axles of the grip arm coordinate system and rotation around the axles of the same 
system, with held operating point (MOV grip arm-referred), 

2. Translation along the axles of the grip arm coordinate system, rotation around the axles of the basis coordinate system (TMOV grip arm- 
referred), 

3. Translation and rotation along that and/or. around the axles of the basis coordinate system (MOV_TOOL grip arm-referred). This 
corresponds almost to the basis- referred mode BMOV. 

An advantage of this beginning consists of it that at small expenditure three hand procedure modes are available, basis- referred and grip 
arm-referred interpolation also in the hand enterprise is equally treated. In addition one is automatically adjusted grip arm-referred 
interpolated sentence a hand procedure mode during an interruption, which regards the basis coordinate system as operating point and lets 
thus all turns around this point take place. As will become still clearer is the case for the discussion of individual records in the command 
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As possible disadvantage it is to be noted that all movements for the stationary observer take place in opposite direction. If for instance 
(stationary) the tool in positive x-direction of the grip arm coordinate system is to be shifted, the grip arm in negative x-direction must 
move. For the programmer this can be habituation needy. In any case ones it must be supported by an appropriate, grip arm-referred 
actual value announcement. 

Mathematical formulation of the interpolation with homogeneous transformations 

A goal of this section is a uniform derivative of the equations for the different hand procedure modes. The overview is the center of 
attention; those to implementing equations follow concretely only in the next section. Furthermore first only the purely basis- referred hand 
procedure is regarded. The transition to grip arm-referred representation is then relatively simple and becomes in section 4.4 discussed. 

All coordinate systems relevant for the hand procedure are arranged in FIG 11. In the following stand BEZ for any stationary reference 
system (DOLLAR WORLD, DOLLAR COUSIN, DOLLAR ROBROOT), IRO for the robot-internal coordinate system, to which all cartesian being 
before the inverse transform must be converted, and CR for the grip arm coordinate system, which is sequentially again computed with the 
interpolation. WZ' indicates the situation of the grip arm coordinate system in the next interpolation clock. 

With the cartesian hand procedure the three coordinates x, y, z and the roll, pitch and Yaw angle (RPY angle) are interpolated A, B, C (with 
robots with less than six degrees of freedom individual angles are void). The question, as these coordinates in each interpolation step are 
determined, is first reset. 

On the basis of the differences DELTA x, DELTA y, DELTA z, DELTA A, DELTA B, DELTA C valid for a scanning step one can indicate a 
homogeneous translation and a rotation matrix, which transfer collected the coordinate system CR into the system WZ': EMI13.1 with 
APPROX. = cos (DELTA A), SA = sin (DELTA A) etc. 

The sequence of translation and rotation is significant: EMUS.AItogether one receives therefore six simple possibilities of the application of 
these differential transformations to 2: 

1. TWZ'< Z> = Trans red TWZ< BEZ> 

2. TWZ'< BEZ> = Trans TWZ< BEZ> red 

3. TWZ'< BEZ> = TWZ< BEZ> of Trans red 

4. TWZ'< BEZ> = red Trans TWZ< BEZ> 

5. TWZ'< BEZ> = red TWZ< BEZ> of Trans 

6. TWZ'< BEZ> = TWZ< BEZ> red Trans 

Each multiplication means each multiplication from right from left that the transformation concerned in the reference coordinates is 
implemented, against it an operation in grip arm coordinates. 

The combination [Trans red] is clearly simpler in practice to handle than [red Trans], since translation and rotation work decoupled. Thus 
are only the first three cases of practical interest. 

The first form, [Trans red TWZ< BEZ>], represents so far the not implemented mode BMOV: A grip arm coordinate system described in 
reference coordinates is shifted first the axles of three-dimensional axes turned (multiplication with red from left), then in reference 
coordinates (multiplication with Trans from left). 

The second variant corresponds to the mode TMOV: All shifts take place in reference coordinates, all turns use the axles of the grip arm 
coordinate system (multiplication with red from right). 

Jk top 

The third case describes the mode MOV_TOOL: First in grip arm coordinates one shifts, one turns then the axles of the shifted system. 

The mode MOV does not have correspondence of this simple form. If one wanted to describe the arithmetic operations by multiplication of 
homogeneous stencils, one would have to release< TWZ> BEZ only once from its translatorischen portion (into the origin of three- 
dimensional axes to shift), then from left by red to multiply, which translatorischen portion again and finally also the shift of Trans near- 
multiplied from left add. Only by summary of the sequence from shift in the origin, rotation and back shift to a homogeneous matrix Rot* 
one receives again a simple expression: 

7. (TWZ'< BEZ>) MOV = Trans Rot* TWZ< BEZ> 

with EMI14.1 one regards translatorischen and rotatorischen portion within the homogeneous stencils separately, comes one however to a 
more efficient calculation specification (in the ACR is already implemented). 

4.3 computation of translation and rotation 

The transformation regulations for the different modes, represented with the help of homogeneous stencils, serve above all the analytic 
description. For the numeric implementation it is more meaningful to implement all stencil multiplications in front. Shift and turn can be 
separately from each other computed then with clearly fewer arithmetic operations and. 

By Partitionieren of the current grip arm matrix one< receives> TWZ BEZ into a rotatorischen portion of R and a translatorischen portion of 
p: EMI15.1 all equations supply their result in the reference system furthest left illustration matrix. World, robot foot and basis coordinates 
(DOLLAR WORLD, DOLLAR ROBROOT, DOLLAR COUSIN) are equally meaningful. The use of the grip arm coordinate system would be 
formally correctly (with R = I and p = 0), however in all four cases only grip arm-referred movements would permit, separates here thus. 
The result of the computations lies thus always in a stationary coordinate system forwards or at least in in a coordinate system, whose 
movement admits from the beginning is (when using DOLLAR COUSIN with auxiliary axles). 
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For reasons of the uniformity the equations to here were fornnulated with differential translations and rotations. At some modes one can 
work however also with absolute data, D.h. in each interpolation clock not indicate the difference to the preceding clock, but the difference 
at the beginning of the movement. This applies for D to all imaging equations, in which the differential values are formulated always in 
reference coordinates. h. simply to be added or from left near-multiplied. 

Therefore one can indicate the rotation DELTA R and the shift DELTA p in the modes BMOV and MOV both absolutely, in the mode TMOV 
nevertheless still the shift. The variant MOV_TOOL permits against it only differential operations, since the reference system CR (R, p) in 
each interpolation clock changes. 

Mathematical formulation of the grip arm-referred hand procedure 

After the formulation of the basis-referred hand procedure all necessary bases are already put. The only difference exists in the change of 
the point of view: in place of the movement of the Frames CR relative to BEZ one indicates now BEZ relative to CR, must the equations for 
the change from an interpolation clock to the next therefore as follows set: 

1. (TBEZ'< CR>) BMOV = Trans red TBEZ< CR )< BMOV grip arm-referred) 

2. (TBEZ'< CR>) MOV = Trans Rot* TBEZ< CR )< MOV grip arm-referred) 

3. (TBEZ'< CR>) TMOV = Trans TBEZ< CR> red (TMOV grip arm-referred) 

4. (TBEZ'< CR>) MOV_TOOL = TBEZ< CR> of Trans red (MOV_TOOL greiferbez.) 

The first case (BMOV) is specified, it the origin of the grip arm coordinate system the operating point would only for the sake of 
completeness make, what is to be avoided by the grip arm-referred hand procedure straight. Furthermore in practice only BEZ = BA might 
be meaningful (as with the basis- referred BMOV). 

The computing course with the other modes covers itself almost with the basis-referred hand procedure. It must only 

1. at the beginning of the hand procedure the initial position TBEZ< CR> to be made available, D.h., if straight were switched to grip arm- 
referred interpolation, TBEZ is <CR> = (TWZ< BEZ>)< ->< 1> to compute, 

2. CR grip arm-referred computed new position< TBEZ'> in each interpolation clock into a basis-referred representation to be converted, 
TWZ'< BEZ> = (TBEZ'< CR>)< ->< 1>. 

Apart from it the equations derived above can be used invariably. One recognizes the relationship of this solution for grip arm-referred 
interpolation during program processing (section 2.2), for those likewise only Frame inversions during the sentence preparation (S. also 
section 7) and after each interpolation clock to be introduced. 

One can accomplish the inversions naturally also in front analytically, so that the equations in basis-referred representation are present: 

1. (TWZ'< BEZ> ) BMOV = TWZ< BEZ> (red)< ->< 1> (Trans)< ->< 1> 

2. (TWZ'< BEZ> ) MOV_TOOL = TWZ< BEZ> (Rot*)< ->< 1> (Trans)< ->< 1> 

3. (TWZ'< BEZ> ) MOV = (red)< ->< 1> TWZ< BEZ> (Trans)< ->< 1> 

4. (TWZ'< BEZ> ) TMOV = (red)< ->< 1> (Trans)< ->< 1> TWZ< BEZ> 

The inversions of the differential rotations and translations turn out relatively simply, there only the differential shifts and twists (DELTA x 
to DELTA C) the sign change. On the other hand in addition, the sequence is exchanged of rotation and translation, one could to derive and 
implement new thus not the existing algorithms use, but would have. 

In favor of as homogeneous a structure of the control as possible it might be more favorable to accomplish the interpolation grip arm- 
referred with following inversion in each interpolation clock. The basis-referred representation may clarify only that these hand procedure 
modes actually differ from the so far-existing and that a stationary observer sees all differential shifts and twists with reverse sign. 

Jk top 

Transformation into robot-internal coordinates 

The positions of the grip arm coordinate system (TWZ* BEZ), computed< in> reference coordinates, must be converted for the computation 
of the oh desired values into robot-internal coordinates. Since, as be stated above, the movement of three-dimensional axes can be 
expected to be familiar, one receives relatively simple transformation regulations. 

With the abbreviation BEZ to three-dimensional axes generally applies 

TWZ< BEZ> = TIRO< BEZ> TWZ< IRO> => TIRO< CR> = (TIRO< BEZ>)< ->< 1> TWZ< BEZ> 
The transformation matrix which can be used in each case follows from the following table: 

<tb>< TABLE> Columns=3 

<tb> Head Col 1: BEZ 

<tb> Head Col 2: TIRO< BEZ> 

<tb> Head Col 3: (TIRO< BEZ>)< ->< 1> 

<tb> DOLLAR COUSIN< September> (TBA< incoming goods>)< ->< 1> TRO< incoming goods> TIRO< ROx CELAL=L> (TRO< 
incoming goods> TIRO< R0>)< ->< 1> TBA< incoming goods> 

<tb> DOLLAR WORLD< September> TRO< incoming goods> TIRO< ROx September> (TRO< incoming goods> TIRO< R0> )< ->< 1> 
<tb> DOLLAR ROBROOT< September> TIRO< ROx September> (TIRO< R0> )< -x 1> 
<tb>< /TABLE> 

Production of the speed profiles 

The course of DELTA x, DELTA y, DELTA z, DELTA A, DELTA B and DELTA C can be produced for the new mode BMOV in the same way as 
with the existing modes. Is not necessary a special treatment. 

This is called concrete that for each direction of motion (each component DELTA x to DELTA C) a ?continuous profile? is computed, which 
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consists only of a phase of constant speed. The increase in speed at the beginning and end of the movement is sanded by the Override 
regulation. 



The constant speeds mentioned are effective by machine data given and only for the components, whose procedure keys are kept pressed. 
All other components are zero. 



Jk top 
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© Grelferbezogenes Handverfahren. 

@ Urn das Teachen einer Robotersteuerung zu erieichtern, wird dafur gesorgt, daB der Drehpunkt bei 
Orientierungsanderungen immer im Ursprung eines Basiskoordinatensystems liegt. 




Kontur 
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Bei der numerisch gesteuerten Bearbeitung von WerkstCicken durch eine mehrachsige Maschine, z.B. 
einen Roboter kann es entscheidende technologische Vorteile bringen, wenn gegenuber der herkommllchen 
Bearbeitung bei der das Werkzeug von der Roboterhand uber ein ortsfestes Werkstuck gefuhrt wird, das 
Werkzeug ortsfest angebracht und das Werkstuck von der Roboterhand uber das ortsfeste Werkzeug 
6 gefuhrt wird. FCir die letztgenannte Bearbeitungsart wird durch die Robotersteuerung eine sogenannte 
greiferbezogene Interpolation vorgenommen, wogegen bei der herkommlichen Fuhrung des Werkzeuges 
uber ein ortsfestes Werkstuck basisbezogen interpoliert wird. 

Die greiferbezogene Interpolation bringt denn Anwender nnehrere Vorteile, u. a. wird der Aufbau 
einfacher, man ben5tigt nur noch einen Greifer und spart die Einspannvorrichtung fOr das WerkstOck, ein 
10 ortsfestes Werkzeug unterliegt weniger Beschrankungen in Gewicht und Abmessungen und die Versor- 
gungseinrichtungen fur Schweifidraht, Kuhlnnittel werden deutlich einfacher, da sie nicht uber die Roboterar- 
me zugefuhrt werden mussen. Zweitens erzielt man kurzere Taktzeiten, da man das Werkstuck in einem 
Arbeitsgang ohne Anhalten und Umgreifen heranbringen, bearbeiten und wieder abtransportieren kann. 

Aufgabe der Erfindung ist es bei der greiferbezogenen Interpolation das Teachen mit gefuhrtem 
15 Werkstuck zu erieichtern. Dazu wird eine Variante des kartesisschen Handverfahrens benotigt, bei der 
Translation und Rotation sich auf das ortsfeste Werkzeug beziehen. Insbesondere mu3 das Werkzeug, das 
als Ursprung des Basiskoordinatensystems gewahit wird, der Fixpunkt aller Drehungen sein. 

Diese Aufgabe wird durch die Merkmale der PatentansprUche gelost. 

Ein Ausfuhrungsbeispiel der Erfindung wird im folgenden anhand der Zeichnung naher eriautert. Dabei 



20 zeigen: 

FIG 1 bis FIG 4 Veranschaulichung der greiferbezogenen Interpolation, 

FIG 5 die Fuhrung eines an einer Roboterhand angebrachten Werkzeugs Liber einem 

ortsfesten Werkstuck, 

FIG 6 die Fuhrung eines an einer Roboterhand angebrachten Werksktucks uber einem 

25 ortsfesten Werkzeug, 

FIG 7 das Lernen der Bahn mit gefuhrtem Werkzeug, 

FIG 8 das Lernen der Bahn mit fest aufgespanntem Werkstuck, 

FIG 9 das kartesische Handverfahren mit Drehungen um die Achsen des Basissy- 

stems, 

30 FIG 10a bis FIG 10c greiferbezogene Handverfahr-Modi im Vergleich. 



Bevor auf das greiferbezogene Handverfahren eingegangen wird, sei anhand der Figuren 1 bis 4 
zunachst das Problem der greiferbezogenen Interpolation veranschaulicht. 

Die Frage, wie sich die Roboterhand andern mu6, wenn man nicht das Werkzeug sondern das 
Werkstuck fuhrt, aber die gleiche Relativbewegung zwischen beiden erhalten mochte entzieht sich sehr 

35 schnell dem Vorstellungsvermogen. An einem einfachen zweidimensionalen Beispiel, wie es anhand der 
Figuren 1 bis 4 dargestellt ist, lassen sich einige grundsatzliche Eigenheiten gut klarmachen. FIG 1 zeigt ein 
Werkstuck, dessen Kontur aus geraden Stucken und Kreisabschnitten zusammengesetzt ist. Spannt man 
dieses Werkstuck fest auf, so entspricht die gezeichnete Kontur der Bahn der Werkzeugspitze. Ist das 
Werkzeug rotationssymmetrisch, laBt sich die Kontur mit einer reinen Translationsbewegung abfahren. 

40 Ein gerichtetes Werkzeug mul3 dagegen immer eine bestimmte Orientierung zur Kontur einhalten. Die 
Anderung der Orientierung ist anhand von FIG 2 durch die an der Kontur angreifenden kleinen Pfeile 
verdeutlicht. Setzt man das Werkzeug fest und bewegt das Werkstuck, zeigen diese beiden Falle sehr 
verschiedene Auswirkungen auf die Bewegung der Roboterhand. In FIG 3 wird das Werkstuck von der 
Roboterhand im Bezugspunkt (= Greifpunkt) gegriffen und es wird die Bewegung dieses Punktes betrach- 

45 tet, die notig ist, um die Kontur am feststehenden Werkstuck entlang zu fuhren. 

Bei rotationssymmetrischen Werkzeug kann die Orientierung des Werkstucks stets beibehalten werden, 
lediglich der Kontakt zwischen Kontur und Werkzeug ist sicherzustellen. Die resultierende Bewegung 
entsteht dann einfach durch Spiegelung der Werkstuckkontur in der Mitte der Verbindungslinie zwischen 
Bezugspunkt und Werkzeug. In diesem Fall laSt sich eine greiferbezogen programmierte Bahn offenbar 

50 sehr einfach umrechnen. Man mu6 nur alle Stutzpunkte der Bahn spiegein und kann Abfolge und Lange der 
Bahnsegmente unverandert beibehalten. 

Ein gerichtetes Werkzeug erfordert dagegen eine Umorientierung des Werkstucks wahrend der Bewe- 
gung, und die Uberlagerung von Verschiebung und Drehung erzeugt eine sehr viel komplexere Bahn des 
Greifpunktes, wie sie in FIG 4 dargestellt ist. 

55 Die Bahn besteht zwar nach wie vor aus geraden Stucken und Kreisabschnitten, deren Anzahl, 
Verteilung und Lange hat sich aber deutlich geandert. An alien Ecken der Kontur verharrt das Werkzeug 
eine Zeit lang am gleichen Punkt, wahrend das Werkstuck um diesen Punkt schwenki An Punkt A steht 
dagegen der Greifer still, andert lediglich seine Orientierung, wahrend der groBe Radius des Werkstucks 
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am Werkzeug entlang gefuhrt wird. 

Durch Ecken in der Kontur entstehen dieselben Probleme, wie bei basisbezogener Interpolation nnit 
einem raumlich ausgedehnten Werkzeug. Erstens mufi ein zusatzliches Bahnsegnnent eingefugt werden, 
das lediglich der Umorientierung des Werkstucks dient, zweitens kann diese Umorientierung nicht beliebig 
6 schnell erfolgen. Je groSer der Abstand zwischen Greifpunkt und Werkzeug, desto welter wIrd der Weg, 
den der Grelfer zuruckzulegen hat. Da die Bahngeschwindigkeit begrenzt ist, mu6 hierfur eine ausreichend 
groBe Zeitspanne eingeplant werden. 

In den gezeigten Beisplelen werden gerade Stucken auf gerade Stucke abgebildet und Kreissegnnente 
auf Krelssegmente. Dies liegt jedoch nur an der streng konstant gehaltenen Orientierung des Werkzeugs 
10 zur Kontur und kann nicht verallgemeinert werden. Im ubrigen ist festzuhalten, da3 sich die Geschwindigkeit 
des Grelfers auf den Krelssegmenten durch die Abbildung andert (ann deutllchsten an Ecken). Die 
technologisch wichtlgen Geschwindigkelten konnen jetzt nur noch grelferbezogen bestlmmt werden und 
zwar aus der Bewegung des Werkzeugs relativ zum werkstuckfesten Koordinatensystem. 

Bei der Annaherung an das ortsfeste Werkzeug und nach Ende der Bearbeitung bewegt nnan das 
T5 Werkstuck sinnvollerweise relativ zu einem ortsfesten Koordinatensystem. Man muB daher zwischen beiden 
Interpolationsarten schnell und moglichst auch flieBend mit Hilfe eines Uberschleifsatzes umschalten 
konnen. 

Anhand der Figuren 5 und 6 werden im folgenden die wesentlichen Grundlagen der Interpolation 

beschrieben. FIG 5 zeigt die Fuhrung des Werkzeugs uber ein ortsfestes Werkstuck. Die Bewegung des an 
20 der Roboterhand befestigten Werkzeugs W uber ein ortsfest angebrachtes Werkstuck S stellt den "Normal- 
fall" dar, der hier kurz rekapituliert werden soli. 

Bei einer bekannten Robotersteuerung kann die Bahn des Werkzeugpunktes, dargestellt durch das 
Koordinatensystem WZ relativ zu einem frei wahlbaren werkstuckfesten Basiskoordinatensystem BA ange- 
geben werden. Die Steuerung rechnet diese selbstandig um und zwar zunachst auf Weltkoordinaten WE 
25 (Inertialkoordinaten), dann auf RoboterfuBkoordinaten RO, schlieBlich auf das roboterlnterne Koordinatensy- 
stem IRO. Daraus wiederum ermittelt die Rucktransformation die einzustellenden Achssollwerte. Vom 
Programmierer werden also das Basiskoordinatensystem BA relativ zum Inertialkoordinatensystem WE 
sowie einige ausgezeichnete Bahnpunkte (wobei ein Bahnpunkt jeweils durch Position und Orientierung des 
Tool-Center-Points also der Roboterhand bestimmt ist) relativ zu dem Basissystem BA. Die Interpolation 
30 arbeitet in Basiskoordinaten und erganzt somit in Echtzeit die fehlenden Bahnpunkte. Jeder Bahnpunkt muB 
auf Weltkoordinaten BE umgerechnet werden. Die dazu anzuwendende Gleichung erhalt man durch 
Verfolgen der Transformationskette (Gleichung 1) 

TWE _ T WE T BA/^H a 
wz - Iba Iwz ^•■I 

35 

Wobei T eine Transformationsmatrix ist, die die Position und Orientierung beschreibt. Das Ergebnis eriaubt 
die Berechnung der Achssollwerte gemaB Gleichung 2 

e = K-i(Twz'^°) = K-i((Tro^^T,ro'^°)-^ Twz^')G1.2 

40 

wobei K""" fur die Rucktransformation steht. 

In FIG 6 ist die Fuhrung des Werkstucks uber einem ortsfesten Werkzeug dargestellt. 

In diesem Fall ist das Werkstuck S fest mit der Roboterhand verbunden und wird uber das stationare 
Werkzeug W, z.B. eine Klebeduse Oder eine SchweiBvorrichtung gefuhrt. Man m5chte die Bahn nach wie 
45 vor uber einen werkstuckfesten Koordinatensystem beschreiben und Interpol ieren. Da aber jetzt das 
Werkstuck bewegt wird, muB sich auch das Bezugssystem mitbewegen. 

Eine einfache und universelle Losung des Problems besteht darin, das Basissystem BA in das ortsfeste 
Werkzeug W zu legen und die Bahn als die "Bewegung" dieses Basissystems BA relativ zum Greifpunkt 
d.h. zum Greiferkoordinatensystem auf dem Werkstuck S zu definieren. Die Bahn des Werkzeugs W wird 
50 also in werkstuckfesten Koordinaten beschrieben. Dies laBt sich durch eine Inversion der basisbezogenen 
Darstellung erreichen. Anstelle von Twz^^ wird nun Tba^^ = (Twz^^)"^ verwendet. Durch Verfolgen der 
Transformationskette erhalt man Gleichung 3 

T WEt WZ _ t we ^ t we _ t WE/t WZ\-i/:ji o 

Twz Tba - Tba =^ Twz - Tba (Tba ) ^i-o 

55 

Die Position des Greiferkoordinatensystems WZ dargestellt in Weltkoordinaten, Twz^^, wird genauso 
weiterverarbeitet, wie bei basisbezogener Programmierung. Ist die Bahn in greiferbezogenen Koordinaten 
angegeben, muB man sie demnach zunachst in diesen Koordinaten interpolieren, was sich nicht von einer 
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Interpolation in einem ortsfesten Basissystenn unterscheldet. Das Ergebnis Tba^^ ist jedoch in jedem 
interpolationstakt zu invertieren, noch vor der Umrechnung auf Weltkoordinaten Twz^^- Inn ubrlgen sind 
beide Interpolationsverfahren vollig gleich. 

Greiferbezogene PTP-Satze sind entsprechend zu behandeln. Der Zielpunkt eines solchen Satzes liegt 
6 ebenfalls als Tba^^ vor, wird daher zunachst invertiert, dann in roboterinterne kartesische Koordinaten 
transfornniert und schlieBlich in Achssollwerte. Hier entsteht nur in der Satzaufbereitung ein geringer 
Zusatzaufwand, die achsspezifische Interpolation kann unverandert bleiben. 

Nach diesen Vorbemerkungen wird nun im folgenden auf das erfindungsgennaBe Verfahren eingegan- 

gen. 

10 

Mdgllchkelten der Programmierung 
Darstellung der Bahn 

15 Urn fur den Anwender nnoglichst ubersichtliche Verhaltnisse zu schaffen, sollte die Programmierung der 

Bahn soweit als moglich Von der "sichtbaren" Geometrie des WerkstLicks ausgehen und fur bewegtes und 
ortsfestes Werkstuck weitgehend gleich ablaufen. Das einfache zweidimensionale Beispiel in der Einleitung 
zeigt, daB eine Abspeicherung der Bahn der Roboterhand relativ zum ortsfesten Werkzeug zwar prinzipiell 
moglich Ist (auch sle besteht nur aus Geraden und Kreisbogen), aber sehr unanschaulich wird. Es blelbt 

20 also nur die Darstellung der Bahn des Werkzeugs relativ zu einem Punkt auf dem Werkstuck, ungeachtet 
der Tatsache, daB das Werkzeug ortsfest ist. 

Neben der gr5Seren Anschaulichkeit hat diese Methode den Vorteil, dafi die Bahndefinition nicht nur 
durch Lernen (Teach-in) mit bewegtem Werkstuck, sondern auch durch Lernen an einem fest aufgespann- 
ten Werkstuck oder durch Ubernahme von CAD-Daten erfolgen kann, wobei die Schnittstelle zur Interpola- 

25 tion stets gleich bleibt. 

Lernen mit gefuhrtem Werkstuck 

Bei diesem Ansatz wird das Werkstuck genauso gegriffen wie bei der spateren Bearbeitung und im 

30 Handbetrieb so bewegt, daB charakteristische Punkte der Kontur uber das ortsfeste Werkzeug zu stehen 
kommen (Fig 7) Dabei muB naturlich auch die Orientierung gelernt werden. Der Programmierer spezifiziert 
auSerdem, wie diese Punkte durch CP- oder PTP-Satze zu verbinden sind. Das Basiskoordinatensystem 
sollte in das Werkzeug gelegt werden. Abgesehen von der Tatsache, daB Werkzeug- und Basiskoordinaten- 
system hier ihre Rollen vertauschen, besteht fur den Anwender kein Unterschied zur basisbezogenen 

35 Programmierung. 

An jedem der gelernten Bahnpunkte sind der Steuerung bekannt: 

- Position des Werkzeugs in Weltkoordinaten: Tba^^ 

- Position des Greifers (des TCP): Twz^^ 

Wie beim basisbezogenen Lernen berechnet man daraus die Position des Greiferkoordinatensystems in 
40 Bezug auf das Basissystem, also hier in Bezug auf das ortsfeste Werkzeug 

T BA - /T WE\-1 T WE 

'wz - Cba ) 'wz 

Um den gelernten Punkt in Werkstuckkoordinaten zu speichern, muB dieses Ergebnis lediglich invertiert 
45 werden 

T wz _ /T BA\-1 _ /T WE\-1 y WE 

'ba - ('wz ) - I'wz ) 'ba 

Die von der Interpolation erzeugten Bahnpunkte werden ein zweites Mai invertiert, so daB sich insgesamt 
50 genau die gelernte Bahn ergibt. 

Sollte das Werkzeug nicht wirklich ortsfest sein, sondern z.B. durch Zusatzachsen bewegt werden, ist 
Tba^^ ebenfalls abzuspeichern, um eine spatere Interpolation der Werkzeugbewegung zu ermoglichen. 

Die Bahn konnte auch auf ein anderes werkstuckfestes Koordinatensystem als das des Greifers 
umgerechnet und in diesem Format gespeichert werden. Fur das Lernen und die spatere Interpolation 
55 wurde das jedoch keine Vorteile bringen. 
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Lernen mit feststehendem Werkstiick (FIG 8) 

Das Lernen nnit gefuhrtem Werkstuck kann gelegentlich als "unhandlich" erscheinen. Normalerweise 
wird beim kartesischen Handverfahren stets der Ursprung des Greiferkoordinatensystems als Bezugspunkt 

6 fur Verschiebungen und Drehungen verwendet, um die Hand relativ zu einem ortsfesten Werkstuck leicht 
positionieren zu konnen. 1st dies der einzige vorgesehene Handverfahr-Modus, muB der Progrannmierer bei 
Anderungen der Orientierung eines groBen Werkstucks moglicherweise ungewohnt schnelle Relativbewe- 
gungen zwischen Werkzeug und Kontur beherrschen. Aufierdem kann er bei einem aufwarts gerichteten, 
test montierten Werkzeug sein Arbeitsfeld manchmal schlecht Gberblicken, so daB ein exaktes Lernen 

10 schwierig wird. 

Zur Erieichterung solcher Aufgaben kann die Bahn auch an einenn test montierten Muster-Werkstuck 
definlert werden. Es geht schlieBlich nur darum, die Bahn in einem bekannten, werkstuckfesten Koordina- 
tensystem zu beschreiben, nach Moglichkeit in demselben System, das spater als Greiferkoordinatensy- 

stem verwendet wird. 

T5 Wahrend des Lernvorganges befestigt man an der Roboterhand sinnvollerweise einen "Zeiger" mit 

bekannten Abmessungen, so daB die Position des in diesen Zeiger gelegten Werkzeugkoordinatensystem 
relativ zum Inertialsystem, Twz^^, jederzeit aus den Achsstellungen berechnet werden kann. 

Das Muster-WerkstGck wird so aufgespannt, daB die Position des Basiskoordinatensystems, in dem die 
Bahn definlert wird, in Bezug auf die Weltkoordinaten bekannt ist (Tba^^)- 
20 Die zu lernenden Punkte werden mit dem "Zeiger" angefahren; aus den bekannten Positionen des 
Greifers und des Werkstucks in Weltkoordinaten berechnet man die Position des Greifers in Werkstuckkoor- 
dinaten 

T BA _ /T WE\-1 T WE 

'wz - Cba ) 'wz 

25 

und speichert dies als Bahnstutzpunkt ab. Bis hierher unterscheidet sich die Vorgehensweise von jedem 
"normalen" Lernvorgang nur dadurch, daB noch nicht das endgultige Werkzeug bzw. der endgultige Greifer 
verwendet wird. 

Beim Bearbeitungsvorgang werden die so gelernten Daten lediglich anders interpretiert. Anstelle des 
30 "Zeigers" wird nun das Werkstuck an der Hand befestigt, als "Werkzeugkoordinatensystem" (Greiferkoordi- 
natensystem) wird nun das Bezugssystem der Bahn verwendet. Die geanderte Lage dieses Koordinatensy- 
stems relativ zum Flansch ist der Steuerung mitzuteilen. Das Basissystem BA wird nun in das ortsfeste 
Werkzeug gelegt auch diese Anderung muB der Steuerung bekanntgemacht werden. 

Die relativ zum Basissystem gelernte Bahn wird nun genauso verwendet, als sei sie von vornherein 
35 relativ zum Greiferkoordinatensystem definiert worden, d.h. die als Twz^^ abgespeicherten Punkte werden 
nun als Tba^^ interpretiert, ohne an den Zahlenwerten etwas zu andern. 

Die Bahndefinition am fest montierten Werkstuck nutzt den Roboter als MeBmaschine. Da bei diesem 
Verfahren wahrend der Bearbeitung die Hand nicht auf der gleichen Bahn fahrt wie bei der Programmierung 
(vgl. das Beispiel in der Einleitung), stellt es hohere Anforderungen an die absolute Genauigkeit des 
40 Roboters, des Werkstuckes und der Aufspannung als das Lernen mit gefuhrtem Werkstuck. Hinzu kommen 
unterschiedliche Durchbiegungen des Arms durch die verschiedenen Traglasten bei Programmierung und 
Bearbeitung sowie eine Verformung des Werkstucks durch die veranderte Lage. 

Erg^nzende Bemerkungen 

45 

Das basisbezogene Lernen (Teach-in) orientiert sich an folgenden Grundsatzen: 

1. Es wird immer die Position des Greiferkoordinatensystems relativ zum Basissystem $BASE abgespei- 
chert (Twz^^ = $POS_ACT). 

2. Dazu wird das aktuell eingestellte Basissystem herangezogen. Der Anwender muB selbst dafur 
50 sorgen, daB bei der spateren Programmbearbeitung dieselbe oder eine definiert veranderte Basis 

eingestellt wird. 

3. Istwerte werden entweder achsspezifisch oder kartesisch angezeigt. Die kartesische Darstellung 

bezieht sich auf $BASE. 

4. Die gelernte Position darf auch einem Frame zugewiesen werden (z. B. $BASE), um ein neues 
55 Bezugskoordinatensystem zu definieren. 

5. Es ist vorgesehen, uber eine "Voreinstellungs"-l\/laske nur ausgewahlte Komponenten einer Position 
zu ubernehmen. Die anderen sind dann als "nicht initialisiert" gekennzeichnet (Lucken) und mussen 
wahrend der Bewegungsplanung erganzt werden. 
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6. Durch Lernen konnen Aggregate (strukturlerte Konstanten) oder Variablen aus Datenlisten festgelegt 
werden. Letztere werden wie initialisierte Variable behandelt, sind bei der Programmbearbeitung also 
schrelbgeschutzt. 

Fur das greiferbezogene Lernen (mit gefuhrtem Werkstuck) folgt In konsequenter Fortsetzung dieses 
6 Konzepts: 

1. Neben dem Basissystem $BASE muB nun auch der "Interpolationsmodus" (basisbezogen oder 

greiferbezogen) beachtet werden. 

2. Im greiferbezogenen Betrieb wird die Position des Basissystems relativ zum Greiferkoordinatensy- 
stem, also Tba^ abgespelchert. 

10 3. Dazu werden das aktuell eingestellte Basissystem und der aktuell eingestellte Interpolationsmodus 
herangezogen. Der Anwender mul3 selbst dafur sorgen, daB bei der spateren Programmbearbeitung die 
glelchen oder definlert veranderte Verhaltnlsse vorliegen. 

4. Die Anzeige der Istwerte erfolgt entweder achsspezifisch oder kartesisch, die kartesische Darstellung 
zeigt bei greiferbezogener Interpolation die Position des Basissystems relativ zum Greiferkoordinatensy- 

15 stem, also Tba^' 

5. Beim Fullen nicht initialisierter Komponenten, die durch die Voreinstellungs-Maske entstehen konnen, 
mul3 die Bewegungsplanung beachten, daB die vorhergehende Position eventuell noch basisbezogen 
angefahren wurde und daher erst auf greiferbezogene Darstellung umgerechnet werden muB. 

Im ubrigen kann das Konzept fur basisbezogenes Verfahren beibehalten werden. 

20 

Kartesisches Handverfahren 
Bezugssysteme lur Translation und Rotation 

25 Zur Beschleunlgung des Lernvorgangs (Teachen) mit gefuhrtem Werkstuck wird mindestens eine 
weitere Varlante des kartesischen Handverfahrens benotigt, bei der Translation und Rotation sich auf das 
ortsfeste Werkzeug beziehen. Insbesondere muB das Werkzeug, also der Ursprung des Basissystems, der 
Fixpunkt aller Drehungen seln. Die bisher In der ACR vorgesehenen Handverfahr-ModI eriauben zwar 
Orlentlerungsanderungen relativ zum Basissystem, halten dabel aber den Ursprung des Grelferkoordlnaten- 

30 systems (Arbeitspunkt) fast, d.h. fur Drehungen wird nur die Richtung der Koordinatenachsen des Basissy- 
stems ausgewertet nicht aber seine Position. FIG 9 verdeutlicht den Unterschied am Beispiel einer Drehung 
um die x-Achse des Basissystems. 

Wie man sofort erkennt, wird durch Drehungen um den Ursprung des Basiskoordinatensystems die 
Programmierung sehr erieichtert, da Position und Orientierung des Werkstucks direkt am Werkzeug 

35 voneinander entkoppelt sind. 

Tabelle 1 stellt die bisher vorgesehenen Handverfahr-Modi der ACR zusammen. Intern werden drei 
Falle unterschieden: 

1. Translation langs der Achsen eines ortsfesten Koordlnatensystems und Rotation um die Achsen 
desselben System, allerdings bei festgehaltenem Arbeitspunkt (MOV, der oben beschriebene Fall, Bild 6 

40 links), 

2. Translation langs der Achsen eines ortsfesten Koordlnatensystems, Rotation um die Achsen des 

Greiferkoordinatensystems (TMOV), 

3. Translation und Rotation langs der bzw. um die Achsen des Greiferkoordinatensystems 
(MOV_TOOL). 

45 



50 
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Tabeile 1: Varianten des kartesischen Handverfahrens 



Urn die gewunschte Wirkung, namlich Drehungen um den Ursprung des Basissystems, zu erzielen, hat 
man nun zwei Moglichkeiten: Man interpoliert basisbezogen oder greiferbezogen. 

25 Basisbezogenes Handverfahren 

Beschrankt man sich ausschliefilich auf baslsbezogene Handverfahr-Modi, muB ein vierter Fall einge- 
fuhrt werden (im folgenden mit BMOV bezeichnet): 

4. Translation langs der Achsen eines ortsfesten Koordlnatensystems und Rotation um die Achsen 
30 desselben System, wobei diese als feststehende Drehachsen zu interpretieren sind, also nicht nur die 
Drehrichtung angeben (Bild 6 rechts). 

Grundsatzllch sind dieselben Bezugskoordinatensysteme zulassig wie in den ersten beiden Fallen. Die 

Vemendung von $WORLD und SROBROOT durfte allerdings keinen praktischen Nutzen bringen. Es ist 
daher zu uberlegen, ob dieser Modus auf $BASE eingeschrankt werden muB (z. B. aus Sicherheitsgrun- 
35 den). Bine solche zusatzliche Fallunterscheidung durfte andererseits einen hoheren Implementierungsauf- 

wand bedeuten, da das bisherlge, regelmaBige Schema durchbrochen wurde. 

Im HInblick auf Zustandsubergange, z. B. vom Programm-Modus in den Kommando-Modus und zuruck, 
kann die gleiche Strategie verwendet werden wie beim gewohnlichen kartesischen Handverfahren. 

40 Greiferbezogenes Handverfahren 

"Greiferbezogenes Handverfahren" steht hier nicht fur den oben beschriebenen Fall MOV_TOOL, in 
dem Translation und Rotation des Greifers anhand der Ausrichtung des Greiferkoordinatensystems berech- 
net werden (relativ zum Basiskoordinatensystem).Vielmehr wird nun die Bewegung des Basissystems 
45 relativ zum Greiferkoordinatensystem uber die Handverfahrtasten vorgegeben. 

Durch diesen Wechsel des Blickwinkels erhalt man zu jedem der drei bereits definierten Modi eine 
neue, greiferbezogene Variante. Alle drei erfullen das Kriterium, da6 bei Orientierungsanderungen der 
Arbeitspunkt, der nun im Basissystem angesiedelt ist, konstant bleibt. Sie unterscheiden sich in der Wahl 
der Bezugssysteme fur Translation und Rotation (FIG 10a - 10c) 
50 1. Translation (des Basiskoordinatensystems) langs der Achsen des Greiferkoordinatensystems und 
Rotation um die Achsen desselben Systems, bei festgehaltenem Arbeitspunkt (MOV greiferbezogen), 

2. Translation langs der Achsen des Greiferkoordinatensystems, Rotation um die Achsen des Basiskoor- 
dinatensystems (TMOV greiferbezogen), 

3. Translation und Rotation langs der bzw. um die Achsen des Basiskoordinatensystems (MOV_TOOL 
55 greiferbezogen). Dies entspricht nahezu dem basisbezogenen Modus BMOV. 

Ein Vorteil dieses Ansatzes besteht darin, daB mit geringem Aufwand drei Handverfahr-Modi zur 
Verfugung stehen. baslsbezogene und greiferbezogene Interpolation werden auch im Handbetrieb gleichbe- 
rechtigt behandelt. AuBerdem ist bei einer Unterbrechung eines greiferbezogen interpolierten Satzes 
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automatisch ein Handverfahr-Modus eingestellt, der das Basiskoordlnatensystem als Arbeltspunkt betrachtet 
und somit alle Drehungen urn diesen Punkt erfolgen Ial3t. Wie bei der Diskussion von Einzelsatzen Im 
Kommando-Modus noch klarer werden wird, errelcht man auf diesem Weg ein homogeneres System. 

Als moglicher Nachteil ist festzuhalten, dafi alle Bewegungen fur den ortsfesten Beobachter in 
6 entgegengesetzter Richtung erfolgen. Wenn etwa das (ortsfeste) Werkzeug in positiver x-Richtung des 
Greiferkoordinatensystems verschoben werden soil, muB sich der Greifer in negativer x-Richtung bewegen. 
Fur den Programmierer kann dies gewohnungsbedurftig sein. Auf jeden Fall muB er durch eine entspre- 
chende, greiferbezogene Istwert-Anzeige unterstutzt werden. 

10 Mathematische Formulierung der Interpolation mit homogenen Transformationen 

Ziel dieses Abschnittes ist eine einheitliche Ableitung der Gleichungen fur die verschiedenen Handver- 

fahr-Modi. Dabei steht die Ubersicht im Vordergrund; die konkret zu implementierenden Gleichungen folgen 
erst im nachsten Abschnitt. Ferner wird zunachst nur das rein basisbezogene Handverfahren betrachtet. Der 

15 Ubergang auf greiferbezogene Darstellung ist dann relativ einfach und wird in Abschnitt 4.4 besprochen. 

Alle fur das Handverfahren relevanten Koordinatensysteme sind in FIG 11 zusammengestellt. Im 
folgenden steht BEZ fur ein beliebiges ortsfestes Bezugssystem ($WORLD, $BASE, SROBROOT), IRQ fur 
das roboterinterne Koordinatensystem, auf das alle kartesischen Sollwerte vor der RGcktransformation 
umgerechnet werden mussen, und WZ fur das Greiferkoordinatensystem, das bei der Interpolation fortlau- 

20 fend neu berechnet wird. WZ' gibt die Lage des Greiferkoordinatensystems im nachsten Interpolationstakt 
an. 

Beim kartesischen Handverfahren werden die drei Koordinaten x, y, z und die Roll-, Pitch- und Yaw- 
Winkel (RPY-Winkel) A, B, C interpoliert (bei Robotern mit weniger als sechs Freiheitsgraden entfallen 
einzelne Winkel). Die Frage, wie diese Koordinaten in jedem Interpolationsschritt bestimmt werden, sei 
25 zunachst zuruckgestellt. 

Ausgehend von den fur einen Abtastschritt gultigen Differenzen Ax, Ay, Az, AA, AB, AC kann man eine 
homogene Translations- und eine Rotationsmatrix angeben, die zusammengenommen das Koordinatensy- 
stem WZ in das System WZ' uberfuhren: 

I 

! ! AB 

I 

. o"o" o"[T. 

I 

AR [ 0 

I 

. o"o" oT V. 

) Rot( X. AC ) 

+ C^SgCQ 
+ S^SgCQ 

B^c 

50 mit Ca = cos ( AA ), Sa = sin ( AA) usw. 

Die Reihenfolge von Translation und Rotation ist signifikant: 
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Trans ( Ax, Ay, Az ) = 



Rot ( AA. AB. AC ) = 



1 0 0 Ax 
0 1 0 Ay 

0 0 1 Az 

_ 0 0 0 1 

RPY(AA.AB,AC) 



0 0 0 



= Rot( 2. AA ) Rot( y. AE 



RPY ( AA. AB, AC ) 
^A^B 



^A^C 



-s 
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Rot • Trans = 
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Trans • Rot = 
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Insgesamt erhalt man daher sechs einfache Moglichkeiten der Anwendung dieser differentiellen Transfor- 

mationen: 

1 . Twz"^ = Trans Rot Twz^^^ 

r E 
I WZ' 



2. Twz-^^^ = Trans Twz^^^ Rot 



3. Twz' 
Fwz' 
5. Twz' 



= Twz^^^ Trans Rot 
Rot Trans Twz^^^ 
r^^^ = Rot Twz^^^ Trans 

6. Twz'^^^ = Twz^^^ Rot Trans 

Dabel bedeutet jede Multiplikation von links, dafi die betreffende Transformation in den Bezugskoordinaten 
ausgefuhrt wird, jede Multiplikation von rechts dagegen eine Operation in Greiferkoordinaten. 

Die Kombination [Trans Rot] ist in der Praxis deutlich einfacher zu handhaben als [Rot Trans], da 
Translation und Rotation entkoppelt wirken. Somit sind nur noch die ersten drei Falle von praktischem 
Interesse. 

Die erste Form, [Trans Rot Twz^^^], stellt den bisher nicht implementierten Modus BMOV dar: Ein in 
Bezugskoordinaten beschriebenes Greiferkoordinatensystem wird zunachst um die Achsen des Bezugsko- 
ordinatensystems gedreht (Multiplikation mit Rot von links), dann in Bezugskoordinaten verschoben (Multi- 
plikation mit Trans von links). 

Die zweite Variante entspricht dem Modus TMOV: Alle Verschiebungen erfolgen in Bezugskoordinaten, 
alle Drehungen verwenden die Achsen des Greiferkoordinatensystems (Multiplikation mit Rot von rechts). 

Der dritte Fall beschreibt den Modus MOV_TOOL: Zunachst wird in Greiferkoordinaten verschoben, 
dann um die Achsen des verschobenen Systems gedreht. 

Der Modus MOV hat keine Entsprechung dieser einfachen Form. Wollte man die Rechenoperationen 
durch Multiplikation homogener Matrizen beschreiben, mul3te man Twz^^^ erst einmal von seinem translato- 
rischen Anteil befreien (in den Ursprung des Bezugskoordinatensystems verschieben), dann von links mit 
Rot multiplizieren, den translatorischen Anteil wieder zufugen und schlieBlich auch die Verschiebung Trans 
von links heranmultiplizieren. Erst durch Zusammenfassung der Sequenz aus Verschiebung in den Ur- 
sprung, Rotation und Ruckverschiebung zu einer homogenen Matrix Rot* erhalt man wieder einen einfachen 
Ausdruck: 

7. (Twz"^^^)mov = Trans Rot* Twz^^^ 
mit 
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Rof = 
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Betrachtet man translatorischen und rotatorischen Anteil innerhalb der homogenen Matrizen getrennt, 
50 kommt man allerdings zu einer effizienteren Rechenvorschrift (die in der ACR bereits implementiert ist). 

4.3 Berechnung von Translation und Rotation 

Die mit Hilfe homogener Matrizen dargestellten Transformationsvorschriften fur die verschiedenen Modi 
55 dienen vor allem der analytischen Beschreibung. Fur die numerische Implementation ist es sinnvoller, alle 
Matrizenmultiplikationen vorweg auszufuhren. Verschiebung und Drehung konnen dann mit deutlich weniger 
Rechenoperationen und getrennt voneinander berechnet werden. 
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Durch Partitionieren der aktuellen Greifermatrix Twz^^^ in einen rotatorischen Anteil R und einen 
translatorischen Anteil p erhalt man: 



10 



15 
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(Twz'^^^)bmov = Trans Rot Twz^^^ 



{Twz»^^^)mov = Trans Rot' Twz^" = 



(Twz'^^^)tmov = Trans Tw2^E2 Rot = 




Lo 0 0 ; 1 J LO 0 0 1 1 J , 



R AB I C + Ab 

1 



0 0 0 
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{Twz'^^^)mov tool = Twz®^^ Trans Rot = 



I 



0 0 0 



I 



AR 
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Alle Gleichungen liefern ihr Ergebnis im Bezugssystem der ann weitesten links stehenden Abbildungsnnatrix. 

40 Welt-, Roboterful3- und Basiskoordinaten (SWORLD, SROBROOT, $BASE) sind gleichernnaBen sinnvoll. Die 
Verwendung des Greiferkoordinatensystems ware zwar formal korrekt (mit R = I und p = 0), wurde aber in 
alien vier Fallen nur noch greiferbezogene Bewegungen zulassen, scheidet hier also aus. Das Ergebnis der 
Berechnungen liegt somit immer in einem ortsfesten Koordinatensystem vor oder zumindest in in einem 
Koordinatensystem, dessen Bewegung von vornherein bekannt ist (bei Verwendung von $BASE mit 

45 Zusatzachsen). 

Aus Grunden der Einheitlichkeit wurden die Gleichungen bis liierher mit differentiellen Translationen 
und Rotationen formuliert. Bei einigen Modi kann man jedoch auch mit absoluten Angaben arbeiten, d.h. in 
jedem Interpolationstakt nicht den Unterschied zum vorhergehenden Takt angeben, sondern den Unter- 
schied zum Beginn der Bewegung. Dies gilt fur alle Abbildungsgleichungen, in denen die differentiellen 
50 Werte immer in Bezugskoordinaten formuliert sind, d.h. einfach addiert oder von links heranmultipliziert 
werden. 

Demnach kann man in den Modi BMOV und MOV sowohl die Rotation AR als auch die Verschiebung 
Ap absolut angeben, im Modus TMOV immerhin noch die Verschiebung. Die Variante MOV_TOOL Ia3t 
dagegen nur differentielle Operationen zu, da sich das Bezugssystem WZ(R, p) in jedem Interpolationstakt 
55 andert. 
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Mathematlsche Formulierung des greiferbezogenen Handverfahrens 

Nach der Formulierung des baslsbezogenen Handverfahrens sind bereits alle notwendigen Grundlagen 
gelegt. Der einzige Unterschied besteht im Wechsel des Blickwinkels: anstelle der Bewegung des Frames 
6 WZ relativ zu BEZ gibt man nunmehr BEZ relativ zu WZ an, mufi demnach die Gleichungen fur die 
Anderung von einem Interpolationstakt zum nachsten folgendermaBen ansetzen: 

1. (Tbez^^)bmov = Trans Rot Tbez^^ (BMOV greiferbezogen) 

2. (Tbez-^^)mov = Trans Rof Tbez^^ (MOV greiferbezogen) 

3. (Tbez'^)tmov = Trans Tbez^ Rot (TMOV greiferbezogen) 

10 4. (Tbez' ) MOV TOOL ~ Tbez Trans Rot (MOV TOOL greiferbez.) 

Der erste Fall (BMOV) ist nur der Vollstandigkeit halber aufgefuhrt, er wurde den Ursprung des 
Grelferkoordlnatensystems zum Arbeitspunkt machen, was durch das greiferbezogene Handverfahren 
gerade vermieden werden soil. Ferner durfte in der Praxis nur BEZ = BA sinnvoll sein (wie beim 
baslsbezogenen BMOV). 

75 Der Reohengang bei den anderen Modi deokt sioh nahezu mit dem baslsbezogenen Handverfahren. Es 

muS lediglich 

1. zu Beginn des Handverfahrens die Startposition Tbez^^ bereitgestellt werden, d.h., falls gerade auf 
greiferbezogene Interpolation umgeschaltet wurde, ist Tbez^ = (Twz^^^)~^ zu berechnen, 

2. die greiferbezogen berechnete neue Position Tbez'^^ in jedem Interpolationstakt In eine baslsbezogene 
20 Darstellung umgerechnet werden, Twz^^^ = (Tbez'^^)~^ 

Davon abgesehen konnen die oben abgeleiteten Gleichungen unverandert zum Einsatz kommen. Man 
erkennt die Verwandtschaft dieser Losung zur greiferbezogenen Interpolation bei der Programmbearbeitung 
(Abschnitt 2.2), fur die ebenfalls nur Frame-lnversionen bei der Satzaufbereitung (s. auch Abschnitt 7) und 
nach jedem Interpolationstakt elngeflihrt werden. 
25 Man kann die Inversionen naturlich auch vorweg analytlsch durchfuhren, so dai3 die Gleichungen In 
basisbezogener Darstellung vorllegen: 

1. (Twz'^'^ )bmov = Twz^'^ (Rot)-^ (Trans)"^ 

2. (Twz-^'^ )mov_tool = Twz^'^ (Rot*)"^ (Trans)"^ 

3. (Twz-^'^ )mov = (Rot)-i Twz^"^ (Trans)-^ 
30 4. (Twz'^'^ )tmov = (Rot)-i (Trans)-^ Twz^'^ 

Die Inversionen der differentiellen Rotationen und Translationen gestalten sich relativ einfach, da nur die 
differentiellen Verschlebungen und Verdrehungen (Ax bis AC) das Vorzeichen wechseln. Andererseits ist 
aber auch die Reihenfolge von Rotation und Translation vertauscht, man konnte also nicht die vorhandenen 
Algorithmen benutzen, sondern mufite neue ableiten und implementieren. 
35 Zugunsten einer moglichst homogenen Struktur der Steuerung durfte es daher gunstlger sein, die 
Interpolation greiferbezogen durchzufuhren, mit nachfolgender Inversion in jedem Interpolationstakt. Die 
baslsbezogene Darstellung mag lediglich verdeutlichen, daS diese Handverfahr-Modi sich tatsachlich von 
den bishervorhandenen unterscheiden und dal3 ein ortsfester Beobachter alle differentiellen Verschiebungen 
und Verdrehungen mit umgekehrtem Vorzeichen sieht. 

40 

Transformation in roboterinterne Koordinaten 

Die in Bezugskoordinaten berechneten Positionen des Greiferkoordinatensystems (Twz^^^) mussen zur 
Berechnung der Achssollwerte in roboterinterne Koordinaten umgerechnet werden. Da, wIe oben dargelegt, 
45 die Bewegung des Bezugskoordinatensystems als bekannt vorausgesetzt werden kann, erhalt man relativ 
einf ache Transf ormationsvorschriften . 

Mit der Abkurzung BEZ fur das Bezugskoordinatensystem gilt allgemein 

T BEZ _ T BEZ X IRO ^ y WZ _ /y BEZ\-1 y BEZ 
'wz - MRO 'wz ^ MRO - 1 MRO ) ' WZ 

50 

Die jeweils anzuwendende Transformationsmatrix folgt aus der nachstehenden Tabelle: 



BEZ 


-r BEZ 
1 IRO 


/X BEZ\-1 

(mro ) 


$BASE 

$WORLD 

SROBROOT 


/X WE\-1 X WE T RO 
V 1 BA ; 1 RO MRO 

X WE X RO 
1 RO ' IRO 

X RO 
I IRO 


/X WE X R0\-1 X WE 
i 1 RO MRO ) ' BA 

/X WE X RO \-1 
i 1 RO MRO ) 
(T RO \-1 

(mro } 
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Erzeugung der Geschwindlgkeitsprofile 

Der zeitliche Verlauf von Ax, Ay, Az, AA, AB und AC kann fur den neuen Modus BMOV in der gleichen 
Weise erzeugt werden wie bei den bestehenden Modi. Es ist keine Sonderbehandlung notwendig. 
5 Konkret heifit dies, dal3 fur jede Bewegungsrichtung (jede Konnponente Ax bis AC) ein "Endlosprofil" 
berechnet wird, das nur aus einer Phase konstanter Geschwindigkeit besteht. Der Geschwindigkeitssprung 
zu Beginn und Ende der Bewegung wird von der Override-Regelung verschliffen. 

Die genannten konstanten Geschwindigkeiten sind durch Maschinendaten vorgegeben und nur fur die 
Komponenten wirksam, deren Verfahrtasten gedrGckt gehalten werden. Alle anderen Komponenten sind 
10 Null. 

Patentanspruche 

1. Robotersteuerung mit einem greiferbezogenen Handverfahren, dadurch gekennzeichnet, da6 der 
f5 Drehpunkt bei Orientierungsanderungen immer im Ursprung eines Basiskoordinatensystems liegt. 



55 
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Bild 4: Lemen der Bahn mit fest aufgespanntem Werkstuck 



EP 0 671 246 A2 




BAf 



wz 



Drehung urn den Ursprung des Drehung urn den Ursprung des 

Greiferkoordinatensystems j~ g Basiskoordinatensystems 

Blld 6: Kartesisches Handverfahren mit Drehungen 
urn die Achsen des Basissystems 
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MOV graiforbMogan 



TMOV greiferbezogen 





y MOV^TOOL greiferbezogen 



Bild 7: Greiferbezogene Handverfahr-ModI Im Verglelch 
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WE (SWORLD) 

Bild 8: Koordinatensysteme fur das kartesische Handverfahren 



